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ABSTRACT 


This  thesis  develops  and  implements  a  Control  Moment 
Gyroscope  (CMG)  steering  law,  controller  and  active 
balancing  system  for  a  three-axis  satellite  simulator 
(TASS)  .  The  CMGs  are  configured  in  a  typical  pyramid 
configuration  (the  fourth  CMG  position  being  null) .  The 
development  was  done  primarily  with  simulation  and 
experiments  utilizing  Real  Time  Workshop  and  XPC  Target  of 
MATLAB  and  SIMULINK.  The  TASS  is  a  double  circular  platform 
mounted  on  a  spherical  air  bearing  with  the  center  of 
rotation  (CR)  about  the  approximate  physical  geometric 
center  of  the  simulator.  The  TASS  utilizes  three  moveable 
masses  in  the  three  body  axes  for  balancing  which  actively 
eliminate  any  center  of  gravity  (CG)  offset  and  return  the 
CG  to  the  CR.  The  TASS  supports  an  optics  payload  designed 
to  acquire,  track  and  point  a  received  laser  beam  onto  an 
of f -satellite  target.  The  target  may  be  stationary  or 
moving.  Actively  balancing  the  TASS  reduces  the  torque 
output  requirement  for  the  CMGs  while  maintaining  either  a 
stabilized  level  platform  or  a  particular  commanded 
attitude.  Reduction  or  elimination  of  torque  output  from 
the  CMGs  results  in  a  more  stabilized  platform,  less 
structural  induced  vibration,  less  jitter  in  payload  optics 
and  less  power  required  in  spacecraft  applications. 
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I .  INTRODUCTION 

A .  BACKGROUND 

1 .  Bifocal  Relay  Mirror  (BFRM) 

This  thesis  builds  upon  the  previous  work  of  Vincent 
S.  Chernesky  [Ref.  4]  and  his  work  with  the  initial  three 
axis  satellite  simulator  (TASS1) .  This  second  and  improved 
capability  three  axis  satellite  simulator  (TASS2,  also 
referred  to  as  TASS  within  this  document)  continues  the 
work  on  the  first  with  an  upgraded  structure,  control 
system  and  BFRM  payload.  The  history  of  the  BFRM  project 
will  be  briefly  summarized  here.  A  more  detailed  history 
for  the  interested  can  be  found  in  Chernesky' s  thesis  on 
the  TASS1 . 

In  2000,  a  preliminary  satellite  design  for  scissors¬ 
like  BFRM  was  completed  by  Naval  Postgraduate  School  (NPS) 
masters  degree  students'  senior  design  project  to  validate 
a  concept  study  performed  by  the  Air  Force  Research 
Laboratory  (AFRL)  in  Albuquerque,  NM.  The  design  consisted 
of  two  optical  telescopes  in  a  scissors-like  configuration 
(Figure  1) where  a  laser  beam  was  received  from  the  earth  by 
one  of  the  orbiting  optical  telescopes,  passed  to  the 
second  optical  telescope  on  the  satellite  where  it  was  then 
relayed  back  to  earth  to  either  a  cooperative  or 
uncooperative  target.  The  optical  path  between  the 
telescopes  includes  adaptive  optics  for  wave  front 
aberration  correction,  jitter  correction  and  beam  steering. 
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Bifocal  Relay  Minor  Spacecraft 


Figure  1.  BFRM  [Ref.  4] 


In  January  2001,  a  joint  contract  was  awarded  by  the 
National  Reconnaissance  Office  (NRO)  to  both  NPS  and  AFRL 
as  a  joint  project  to  develop  the  concept  in  more  detail. 
Work  was  divided  up  between  AFRL  and  NPS  such  that  AFRL 
would  develop  the  optical  payload  while  NPS  developed  the 
controls  for  acquisition,  tracking  and  pointing. 

2.  Spacecraft  Research  and  Design  Center  (SRDC) 

The  SRDC  at  NPS  consists  of  a  satellite  servicing  lab. 
Fleet  Satcom  lab,  flexible  dynamics  lab,  attitude  control 
and  dynamics  lab  and  a  satellite  design  center.  The 
satellite  attitude  control  and  dynamics  lab  is  host  to  both 
TASS1  and  TASS2  with  each  simulator  occupying  opposite 
sides  of  the  lab.  This  arrangement  allows  for  development 
of  each  simulator  and  future  enhancements  such  as 
cooperative  experiments  between  the  two. 
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II.  HARDWARE  DEVELOPMENT 


The  TASS2  is  comprised  of  several  subsystems 
integrated  to  form  a  notional  satellite  with  subsystems  for 
power,  attitude  determination  and  control,  command  and  data 
handling  and  an  optical  payload:  the  bifocal  relay  mirror. 
This  section  outlines  the  physical  description,  development 
and  integration  of  the  various  subsystems  onboard  the  TASS. 
Also  covered  are  difficulties  encountered  during 
development,  remaining  work  to  be  pursued  and  discrepancies 
between  simulation  and  experimentation. 

TASS2  is  to  support  the  acquisition,  tracking  and 
pointing  requirements  for  the  BFRM  project.  The  ultimate 
goal  of  the  project  is  to  deliver  pointing  accuracy,  for 
the  spacecraft  bus,  in  the  milliradian  region.  The  optical 
payload  goal  is  to  support  nanoradian  pointing  accuracy. 
This  is  not  possible  with  the  current  lab  equipment,  but 
will  allow  "proof  of  concept."  Accuracy  to  that  degree  will 
require  highly  sophisticated  sensors  and  equipment. 

What  the  TASS2  will  do  is  prove  the  concept  of  such 
pointing  accuracy  within  the  limits  of  the  accuracy  on  the 
onboard  equipment . 


A.  OVERVIEW 

The  TASS  (shown  in  Figure  2)  was  constructed  by 
Guidance  Dynamics  Corporation  (GDC)  with  electronics  and 
controllers  designed  and  integrated  by  Automated  Controlled 
Environments  Inc.,  (ACEI) .  The  main  structure  is  built  upon 
2  circular  steel  decks  1.25cm  thick,  1.83m  in  diameter  and 
the  two  decks  separated  into  upper  and  lower  decks  by  15, 
0.5m  long,  circular  standoffs  with  rubber  vibration 
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isolation  on  the  lower  deck  end.  The  center  of  rotation 
(CR)  is  located  21.3cm  below  the  upper  deck  and  is 
comprised  of  a  spherical  bearing  ~30cm  in  diameter.  The 
spherical  bearing  rests  in  a  spherical  cup  supplied  with  80 
psi  air  for  floated  operations.  During  floated  operations, 
air  supplying  the  pedestal  base  raises  the  TASS  ~lcm  for 
near  frictionless  floated  motion.  During  floated 
operations,  the  table  is  restricted  to  3  degrees  of  freedom 
(DOF)  about  the  CR. 


Figure  2 .  TASS2  Overview 


Attached  to  the  upper  deck  is  a  main  optical  deck 
slightly  smaller  in  diameter  than  the  upper  deck.  On  this 
deck  is  attached  the  targeting  optics  which  consist  of  a 
102mm  diameter  Orion  Maksutov-Cassegrain  telescope  with  a 
1300mm  focal  length,  fast  steering  mirror  (FSM)  for  beam 
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positioning,  optics  train  components  for  beam  steering, 
three  computers  for  optical  payload  control,  position 
sensing  devices  (PSDs)  for  fine  pointing  control  of  the 
simulator  structure,  moveable  masses  for  balance  and 
various  power  distribution  and  switching  components. 
Attached  to  the  center  of  the  TASS  and  raised  above  the 
main  optical  is  the  upper  optical  deck.  This  deck  is 
motorized  and  has  one  degree  of  freedom  with  respect  to  and 
parallel  to  the  main  optical  deck  for  tracking  of  a  source 
beam.  This  deck  contains  the  source  beam  receive  optics 
consisting  of  an  Orion  telescope  identical  to  the  targeting 
Orion  telescope,  FSM  and  PSD  for  jitter  control, 
controllers  for  the  FSM  and  PSD  and  optics  for  routing  the 
received  beam  to  the  main  optical  deck  through  the  hollow 
center  section  of  the  TASS. 

Balance  of  the  TASS  is  accomplished  in  part  by  manual 
and  automatic  adjustable  masses.  Manual,  radially 
adjustable  masses,  are  located  and  attached  slightly  below 
the  upper  deck  at  six  locations.  The  masses  are  essentially 
located  every  45°  with  exception  of  the  positive  and 
negative  X  axis.  If  a  mass  adjustment  is  required  along 
this  axis,  the  adjustment  can  be  made  by  moving  the  two 
masses  offset  45°  from  the  axis.  Four  vertically  adjustable 
masses  are  located  on  the  periphery  and  are  used  for 
adjusting  the  center  of  gravity  (CG)  along  the  Y  axis. 
Three  linear  adjustable  masses  are  located  along  the  three 
principal  axes  and  attached  to  a  Daedal  linear  actuator 
operated  by  a  Compumotor  rotary  brushless  DC  motor. 

Attitude  control  is  maintained  by  three  single  gimbal 
GDC  Control  Moment  Gyroscopes  (CMGs)  configured  in  a 
modified  pyramid  configuration  (Figure  3)  with  the 
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traditional  fourth  position  empty  and  filled  by  ballast 
mass  to  maintain  simulator  balance.  The  CMGs  are  attached 
to  a  hinged  frame  and  canted  to  a  beta  angle  (P)  of  -35.25° 
relative  to  the  lower  deck.  The  P,  or  skew  angle,  is 
measured  with  the  vertex  of  the  skew  angle  at  the  center  of 
mass  of  the  CMG,  one  side  of  the  angle  parallel  to  the 
lower  deck  of  the  TASS  facing  inward  and  the  other  side 
passing  through,  and  parallel  to,  the  plane  of  the  CMG 
rotor  such  that  the  angle  less  than  90°  is  measured.  This 
is  not  a  "traditional"  pyramid  arrangement  of  CMGs.  In  the 
traditional  configuration,  the  gimbal  axis  vectors  are 
aligned  such  that  they  are  perpendicular  to  the  face  of  the 
tetrahedron,  resulting  in  a  skew  angle  of  54.75°. 


Figure  3 .  CMG  pyramid  configuration 
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Attitude  determination  is  made  with  a  combination  of 
sensors  including  a  Northrup  Grumman  (formerly  Litton)  LN- 
200  IMU  (Figure  21)  mounted  to  the  underside  of  the  upper 
deck,  a  three  axis  magnetometer  mounted  to  the  upper  deck 
and  a  three  axis  inclinometer  mounted  to  the  underside  of 
the  upper  deck. 

A  VersaLogic  industrial  embedded  PC  (Figure  24)  houses 
a  Diamond  MM32-AT  PC104  for  program  control,  execution  and 
C&DH  functions.  Communication  between  the  embedded  PC  and 
of f-simulator  computer  (desktop  PC  running  Matlab/Simulink) 
is  performed  via  a  wireless  Dlink  router  (Figure  4)  using 
802. 11G  wireless  technology  and  Ethernet  cable  from  the 
router  to  the  embedded  PC.  Major  equipment  locations  are 
shown  in  Figure  5 . 


Figure  4.  DLink  wireless  802. llg  router 
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Figure  5 .  TASS2  equipment  locations 

B.  REFERENCE  FRAMES  AND  AXES 
1 .  GDC  Axes 

The  TASS  was  delivered  with  an  assumed  reference  frame 
during  construction  and  documented  in  the  mass  properties 
spreadsheet.  The  assumed  reference  frame  was  a  left  handed 
(LH)  coordinate  system  of  roll,  pitch  and  yaw  with  yaw 
being  from  the  CR  downwards,  towards  the  earth,  as 
positive.  Roll  and  pitch  axes  then  formed  the  horizontal 
plane  parallel  to  the  upper  and  lower  decks  in  a  LH 
fashion.  The  positive  X  axis  was  from  the  CR  through  the 
center  of  CMG#1  ballasting  weights.  The  positive  Z  axis  was 
from  the  CR  and  passing  through  the  ballasting  weights 
added  in  the  position  of  the  absent  CMG#4  completing  the  LH 
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body  frame.  The  demonstration  program  supplied  with  the 
TASS  was  also  based  in  this  reference  frame. 


Figure  6.  Left  handed  coordinate  system 

2 .  Inertial  Axes 

Inertial  axes  will  be  denoted  by  the  subscript  "N". 
For  operation  and  simulation  of  a  satellite  in  orbit,  it 
was  necessary  to  redefine  the  axes  as  defined  by  GDC  to 
correspond  to  industry  and  educational  standards. 

Though  the  intuitive  yaw  axis  (Z)  would  appear  to  be 
the  vertical  axis  passing  through  the  CR  and  air  bearing 
pedestal  base,  this  would  not  agree  with  our  payload 
pointing  and  where  the  laser  source  and  targets  were 
located.  In  our  case,  the  TASS  is  assumed  to  be  "flying" 
such  that  the  far  wall  of  the  lab  is  earth  and  the  flight 
path  is  parallel  with  the  floor.  Since  in  traditional 
satellite  control  the  +  Z  axes  points  towards  the  earth, 
that  determined  our  +ZN  axis. 

The  desired  flight  path  for  simulations  is  parallel  to 
the  lab  floor  and  in  order  to  align  the  YN  axis  upwards  (for 
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convenience) ,  produced  a  direction  of  flight  to  the  right 
as  one  faces  the  TASS  (-ZN  direction)  .  The  resulting  RH 
coordinate  system  located  the  pitch  axis  (YN)  upwards,  the 
roll  axis  (XN)  parallel  to  the  floor  and  to  the  right  and 
the  yaw  axis  (ZN)  down  the  length  of  the  lab. 

3 .  Body  Axes 

Body  axes  will  be  denoted  with  the  subscript  "B".  The 
body  axes  are  identical  to  the  control  axes  used.  The  +YB 
axis  was  set  originating  from  the  CR  vertically  through  the 
TASS.  The  -YB  correspondingly  passes  downward  through  the 
air  bearing  pedestal  base.  The  +XB  axis  was  set  passing 
through  CMG#3  and  the  +ZB  passing  through  CMG#2 .  In  a 
stationary  situation,  this  aligned  the  body  axes  with  the 
inertial  axes.  The  body  axes  can  be  seen  in  Figure  5  in 
relation  to  the  equipment  and  in  Figure  7  for  graphical 
representation . 


*■¥ 


Figure  7 .  Right  handed  coordinate  system 
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3 .  Principal  Axes 

Principal  axes  were  assumed  to  coincide  with  the  body 
axes  for  simulation  purposes.  The  moment  of  inertia  matrix 
as  calculated  in  the  mass  properties  spreadsheet  (Appendix 
B)  shows  close  symmetry  between  the  XB  and  ZB  axes.  Since 
equipment  on  the  TASS  is  changing  often,  calculation  of  the 
exact  principal  axes  is  left  for  a  later  date.  It  is 
anticipated  there  should  be  little  control  influence  in 
early  experiments  with  a  slight  difference  between  the  body 
axes  and  principal  axes. 

4 .  Orbit  Axes 

The  body  axes  origin  is  centered  at  the  CR.  Since  the 
TASS  is  fixed  relative  to  the  inertial  reference  frame,  no 
orbit  reference  frame  is  required.  All  coordinate 
transformations  can  be  accomplished  from  body  to  inertial, 
or  reverse,  directly. 

5.  Mass  Properties  Axes 

The  mass  properties  spreadsheet  [Ref.  9]  (Appendix  A) 
was  delivered  by  GDC  based  on  their  LH  coordinate  systems 
explained  previously.  It  was  necessary  to  convert  equipment 
positions  based  in  the  GDC  body  reference  frame  to  a  right 
handed  reference  frame  standard  to  the  SRDC,  academia  and 
commercial  institutions . 

C.  CONTROL  MOMENT  GYROSCOPES 

1 .  Description 

The  CMGs  (Figure  8) were  built  by  GDC  and  are  24.4  N-m- 
s  (based  on  a  max  rotor  speed  of  2800  rpm) ,  single  gimbal, 
variable  speed  CMGs  (SGVSCMG) .  The  controller  hardware  was 
built,  supplied  and  integrated  by  ACEI.  The  controllers 
include  rotor  speed  controllers  (Figure  9)  and  gimbal 
controllers  (Figure  10) .  The  CMGs  can  be  operated  in  either 
single  gimbal  CMG  mode,  maintaining  a  constant  rotor  speed 
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and  gimbaling  the  axis,  or  in  reaction  wheel  mode  by  fixing 
the  gimbal  axis  and  operating  the  CMG  in  variable  speed 
mode  to  control  attitude.  The  CMGs  provide  gimbal  angle 
feedback  by  rotary  encoders  monted  on  the  gimbal  shaft 
(Figure  11) 


Figure  8.  GDC  SGVSCMG 


Figure  9 .  CMG  Rotor  speed  controller 
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Figure  10.  CMG  girnbal  controller 


Figure  11.  CMG  gimbal  position  encoder 


2 .  Failures  and  Troubleshooting 

During  simulation,  it  was  noted  that  control  movements 
were  non-smooth  at  times.  For  the  CMGs,  being  commanded  via 
a  PD  controller,  gains  were  initially  suspect.  Gains  were 
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tuned  using  the  Nichols-Ziegler  method.  Slight  variations 
in  gains  did  not  alter  the  sporadic,  seemingly  uncommanded 
movements  of  the  CMGs .  Next,  hardware  was  investigated. 
Investigation  revealed  a  10°-20°  play  in  the  gear  system 
connecting  the  DC  motor  to  the  gimbal .  The  gimbal  position 
feedback  was  not  seen  as  changing  for  10°-20°  of  commanded 
gimbal  angle.  This  resulted  in  an  almost  bang-bang  control 
system.  Disassembling  the  gear  system  revealed  loose  set 
screws  securing  the  gears  to  their  respective  shafts. 

CMG  #1  was  discovered  to  have  an  oscillatory  noise  on 
it's  gimbal  position  feedback  signal.  Figure  12  shows 
commanded  position  in  blue  and  feedback  position  in  green. 
Periodic  spikes  up  to  1.4°  in  magnitude  can  be  seen.  CMG#2 
is  depicted  in  Figure  13  and  is  also  representative  of 
CMG#3 .  Feedback  position  is  identical  to  commanded  position 
as  would  be  expected.  It  is  unknown  as  to  the  cause  of  the 
~10Hz  oscillatory  noise,  but  the  controller  electronics  is 
suspect.  The  CMG  and  controller  has  been  returned  to  the 
manufacturer  for  modification  the  controller  electronics. 
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D.  POWER  SWITCHING  AND  DISTRIBUTION  SYSTEM 

The  power  subsystem  is  a  24.8  Vdc  (nominal)  bus  rated 
at  100A  and  is  composed  of  the  power  switch  box,  power 
switching  electronics  assembly,  batteries,  external  power 
and  external  battery  charger.  At  a  zero-torque,  CMG  rotors 
not  rotating  condition,  current  draw  is  no  more  than  ~4A. 
Operation  in  this  configuration  can  continue  for  up  to  6 
hours.  CMG  operation  will  reduce  this  time.  Under  actual 
conditions  with  CMGs  operating  and  applying  a  torque  to  the 
TASS,  a  maximum  of  two  hours  continuous  operation  was 
observed . 

The  power  system  allows  for  flexibility  in  operation 
of  the  TASS.  For  example,  the  batteries  may  be  charged 
while  operating  the  TASS  from  external  power,  CMG  rotors 
can  also  be  powered  via  battery  while  operating  the  TASS  on 
external  power.  As  a  safety  measure,  CMG  rotors  may  only  be 
operated  from  battery  power  to  prevent  over  current 
conditions  on  external  power.  CMG  gimbals,  however,  may  be 
operated  on  external  power. 

1 .  Power  Switch  Box 

The  switch  box  (Figure  14)  is  the  main  user  interface 
for  powering  TASS2  components.  The  front  panel  contains 
individual  power  switches  for  the  CMGs,  Balance 
Controllers,  IMU,  Top  Deck  Controller  and  Payload 
Electronics.  The  switchbox  provides  overcurrent  protection 
for  components  by  automatically  switching  off  power  if  bus 
voltage  drops  below  18.5V. 
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Figure  14.  Power  switch  box 


2.  Power  Switching  Electronics  (PSE) 

The  PSE  provides  an  interface  for  the  Industrial 
Embedded  Computer  (IEC)  to  communicate  with  all  the 
digitally  controlled  devices  on  the  TASS  via  a  single  RS- 
232  interface.  The  PSE  also  contains  analog  conditioning 
electronics  for  the  sun  sensor. 

3 .  Batteries 

For  floated,  internal  power  operation,  two  Yuasa  12V- 
24Ah  sealed  gel-cell  batteries  (Figure  15)  are  connected  in 
series  providing  a  nominal  24.8  Vdc  bus. 
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Figure  15.  Gel  cell  battery 


4 .  External  Power 

External  power  is  provided  via  an  umbilical  from  an 
external  24  Vdc  source  to  the  power  switch  box  receptacle. 
The  red  switch  controls  the  source  of  power.  Out  selects 
internal  power  while  "IN"  selects  external  power. 

5 .  Battery  Charger 

The  battery  charger  is  external  to  the  TASS  and 

connects  to  the  TASS  via  the  same  umbilical  used  for 

external  power  (Figure  16)  .  Two  chargers  (one  for  each 

battery)  connect  to  a  quick  disconnect  in  the  umbilical 

which  then  plugs  into  the  power  switch  box  receptacle. 
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Figure  16.  Battery  chargers 


E .  SUN  SENSOR 

The  sun  sensor  (Figure  17)  utilizes  a  four-sensor 
array  that  determines  the  average  location  of  the  maximum 
point  of  light  along  a  vertical  and  horizontal  axis  in  its 
field  of  view  (±10°)  .  Average  location  is  output  in  the 
form  of  an  error  signal  with  an  analog  value  of  1.5  to  3.5 
Vdc  in  each  axis.  An  "on  center"  condition  is  indicated  by 
a  2.5  Vdc  output  in  each  axis.  The  corresponding  average 
scale  factor  is  44mV/deg. 
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Figure  17.  Sun  sensor  (IR) 


F .  STAR  SENSORS 

A  "pseudo"  star  sensor  (Figure  18)  was  implemented  in 
a  previous  thesis  [Ref.  12]  by  using  an  attitude  sensor 
based  on  a  laser  (Figure  19)  and  position  sensing  device 
(PSD)  capable  of  an  accuracy  down  to  10  prad.  The  PSD 
chosen  was  a  position  sensing  module  (PSM)  by  ON-TRAK 
Photonics,  Inc.  A  20mm  sensor,  the  PSM  is  capable  of 
discriminating  4.883  X  10~6  meters. 
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Figure  19.  Star  sensor  laser 
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The  star  sensor  uses  a  laser  mounted  on  the  TASS, 
transmitted  through  the  star  sensor  beam  splitter  to  a 
mirror  (Figure  20)  mounted  on  the  lab  wall  (one  for  the  +X 
axis  and  one  for  the  -Z  axis)  .  The  beam  is  reflected  back 
to  the  star  sensor  beam  splitter  where  is  then  directed 
downward  to  the  PSM.  Any  deviation  in  the  TASS  attitude 
will  appear  as  a  corresponding  deviation  of  the  laser  beam 
on  the  PSM. 


Figure  20.  Star  sensor  inertial  mirror 


G.  INERTIAL  MEASUREMENT  UNIT  (IMU) 

The  IMU  (Figure  21)  is  a  Northrop  Grumman  (formerly 
Litton)  LN-200  fiber  optic  gyro  (FOG)  with  silicon 
accelerometers.  Spin-up  time  is  a  minimum  of  0.8  sec  with 
maximum  accuracy  being  achieved  after  5  sec.  Bias  variation 
is  a  maximum  of  0.35  deg/hr  with  repeatability  of  1  deg/hr 
to  10  deg/hr  (1  sigma) . 
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Figure  21.  IMU 

H .  MAGNETOMETER 

A  Billingsley  Magnetics  TFM100-G2  three  axis 
magnetometer  (Figure  22)  is  used  on  the  TASS.  While  the 
outputs  can  be  noisy,  operating  it  in  a  differential  mode 
with  an  additional  magnetometer  could  prove  to  provide  a 
very  accurate  "north"  for  the  pitch  (Y)  axis. 


Figure  22 .  Magnetometer 
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Added  difficulty  in  incorporating  the  Magnetometer 
arises  in  calibration.  Completely  removing  surrounding 
ferrous  material  is  impossible.  The  lab  structure  (walls, 
ceiling) ,  TASS  hardware  (equipment,  wiring)  and  other  stray 
magnetic  fields  will  make  calibration  difficult. 

I .  INCLINOMETERS 

Angles  measured  to  the  horizontal  inertial  axes  are 
done  with  two  Rieker  N3  inclinometers.  Full  measuring  range 
of  ±30°,  they  have  a  resolution  of  <.005°.  The  stated 
maximum  non-linearity  is  <0.2%  of  the  measured  value 
implying  a  max  non-linearity  of  <0.06°.  Response  time  is 
stated  to  be  <.3  sec  which  might  have  an  influence  on 
controllability . 


Figure  23.  Inclinometer 

Early  on  in  development  while  measuring  inclinometer 
signals  in  the  X  axis,  a  noted  non-linearity  was  observed 
as  can  be  seen  in  Table  1.  Though  not  exhaustive  data,  it 
appears  a  non-linearity  greater  than  the  manufacturer's 
stated  0.2%.  AECI  plans  on  upgrading  controller  electronics 
to  remove  circuitry  that  was  added  to  increase  the  sensor' s 


signal  to  noise  (SNR)  ratio.  When  in  operation,  the 
circuitry  was  noted  to  produce  unwanted  distortions  in  the 
sensor  signal. 


Actual  Angle 

Recorded  Angle 

Bias 

o, 

o 

0° 

0.86° 

+0.86° 

-- 

0 

00 

00 

l 

-3.08° 

+0.40° 

11% 

-7 . 18° 

-6.63° 

+0.55° 

7.7% 

-12.38° 

-11.76° 

0.62° 

5% 

Table  1 .  Inclinometer  non-linearity 


J.  INDUSTRIAL  EMBEDDED  COMPUTER 

The  IEC  is  a  PC-104  format  computer  based  on  the  Intel 
Pentium  III  running  at  750Mhz  and  running  Matlab  xPC 
onboard.  The  IEC  utilizes  two  cards,  a  Diamond  MM32-AT  and 
Diamond  Ruby  MM8  for  monitoring  analog  sensor  inputs  and 
communicating  with  the  PSE  assembly  via  a  RS-232  interface. 


Figure  24.  Industrial  Embedded  Computer  (IEC) 
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K. 


MASS  BALANCING  SYSTEM 


The  mass  balancing  subsystem  (Figure  25)  is  composed 
of  three  proof  masses  (cylindrical  10.89  Kg  masses) ,  three 
linear  actuators  with  linear  position  encoders  and  leveling 
mass  interfaces.  All  linear  actuators  are  identical  except 
the  vertical  axis  which  is  equipped  with  an  actuator  brake 
to  prevent  mass  movement  in  the  vertical  direction  due  to 
gravity . 


Figure  25.  Mass  balancer 


1 .  Linear  Actuators 

The  linear  actuators  are  404XR  Series  standard 
precision  Parker-Hannif in  Daedal  leadscrew  tables  capable 
of  150mm  of  travel  with  an  accuracy  of  18ym  and 
bidirectional  repeatability  of  ±5pm.  Maximum  acceleration 
is  rated  at  20m/sec1 2. 

2 .  Linear  Encoder 

The  linear  encoder  converts  linear  position  into  a 
digital  output.  The  encoder  has  a  positional  accuracy  of  ±3 
microns  and  a  resolution  that  is  dependent  on  selected 
speed  of  the  actuator  as  shown  in  Table  2 . 
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Actuator  Speed 

Encoder  Resolution 

3.0  m/ sec 

1 . 0  micron 

1.5  m/ sec 

0 . 5  micron 

0.3  m/ sec 

0 . 1  micron 

Table  2 .  Linear  Encoder  Resolution 


Home  repeatability  is  based  on  encoder  resolution  with 
repeatability  ±2  counts  times  the  encoder  resolution  with 
best  case  being  1  micron.  Home  repeatability  is  shown  in 
Table  3 . 


Encoder  Resolution 

Home  Repeatability 

1 . 0  micron 

±2  microns 

0 . 5  micron 

±1  micron 

0 . 1  micron 

±  micron 

Table  3 .  Home  Repeatbility  Accuracy 


3.  Leveling  Mass  Interface  (LMI) 

The  interface  (Figure  26)  converts  serial  inputs  into 
commands  to  control  the  linear  actuator  it  is  attached  to. 
The  interface  can  save  the  last  "home"  position  to  non¬ 
volatile  memory  (NVRAM)  so,  when  powered  up,  the  controller 
can  seek  the  last  saved  position.  A  command  is  provided  to 
automatically  center  the  actuator  and  set  it  as  "home" . 


27 


Figure  26.  Leveling  mass  interface  (LMI) 


The  LMI  accepts  bitwise  commands  as  an  unsigned  8  bit 
integer  with  bits  performing  commands  in  Table  4 . 


Bit 

Mode  CMD 

Description 

0 

Enable 

1-motor  on;  0-motor  off 

1 

Save 

0  to  1  transition  sets  new  home  position 

2 

Brake 

1-brake  on;  0-brake  off  (normally  not  used) 

3 

Center 

Seeks  center  of  travel  and  sets  home 

1 -active ;  0- inactive 

4 

Home 

Seeks  saved  home  pos:  1-active;  0-inactive 

5 

NULL 

6 

NULL 

7 

NULL 

Table  4 .  Balance  LMI  commands 


Actual  position  commands  are  issued  as  a  signed  16  bit 
integer.  The  command  is  converted  into  a  delta  position 
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(  +  /-)  from  the  saved  home  position.  The  decimal  value  of 
32768  indicates  a  delta  of  zero  while  decimal  zero  is  a 
maximum  negative  delta  position  and  decimal  65536  is  a 
maximum  positive  delta  position.  The  scale  factor  is  1916.3 
counts/cm.  The  balancer  table  has  a  maximum  travel  of  15cm, 
so  the  maximum  position  command  in  counts  that  can  be 
issues  is  61512  for  a  maximum  positive  delta  and  4023  for  a 
maximum  negative  delta  position. 

4 .  Failures/Troubleshooting 

During  initial  operations,  it  was  noted  that  on  TASS 
powerup,  #2  mass  balancer  would  move  and  position  the 
balance  mass  to  an  off-center  position.  Two  reasons  this 
was  abnormal:  the  power  switch  on  the  switchbox  for  the 
mass  balancers  was  off  and  previous  simulations  had  set  the 
NVRAM  home  position  at  the  center.  The  mass  was  not  only 
moving  with  the  power  switch  off,  but  moving  to  a  non- 
stored  position.  The  balance  controllers  are  currently  back 
with  the  manufacturer  undergoing  modifications. 

L .  VIDEO  SYSTEM 

The  video  system  is  composed  of  two  Dalsa  cameras  for 
differentiating  targeting  and  tracking  laser  beams. 
Identical  camera,  one  is  affixed  with  a  red  filter,  the 
other  with  a  green  filter  as  shown  in  Figure  27.  One  of  the 
other  two  camera  used  for  field  of  view  determination  can 
be  seen  as  well. 
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Figure  27.  Video  camera 


M.  OPTICS 

The  optics  payload  was  supplied  by  AFRL .  The  optics 
consist  of  two  102mm  diameter  Orion  Maksutov-Cassegrain 
telescopes  with  a  1300mm  focal  length,  two  Baker  Adaptive 
Optics  fast  steering  mirrors  (FSM)  (Figure  28)  for  jitter 
control  and  beam  positioning  and  various  optics  train 
components  for  beam  routing  and  alignment.  The  payload  can 
be  seen  in  Figure  29. 
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Figure  28.  Fast  Steering  Mirror  (FSM) 


Figure  29.  BFRM  payload 
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N.  OPTICS  CONTROL 

The  payload  optics  program  and  control  is  provided  by 
two  personal  computers  (PCs)  seen  in  Figure  29.  Provided  by 
AFRL,  these  computers  run  the  software  for  calibration, 
testing  and  operational  tracking.  FSM  and  Jitter  PSD 
controllers  are  shown  in  Figure  30. 


Figure  30.  FSM  Controller  (top),  PSD  Controller  (hot) 


Figure  31 .  Jitter  PSD 
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The  upper  optics  deck  that  supports  the  receive 
telescope,  jitter  elimination  equipment  and  controllers  is 
motorized  with  one  DOF  with  respect  to  the  vertical  body 
axis,  it  is  controlled  via  a  table  drive  motor  shown  in 
Figure  32  . 


Figure  32 .  Optical  deck  motorized  drive 


O.  MASS  PROPERTIES 

1 .  Background 

The  initial  mass  properties,  as  delivered  by  GDC,  were 
specified  and  provided  in  the  form  of  a  Microsoft  Excel 
spreadsheet.  The  initial  mass  properties  were  specified 
using  the  GDC  assumed  coordinate  system  and  had  to  be 
transformed  to  the  body  coordinate  system  in  use.  As 
development  progressed  and  new  equipment  was  added  to  the 
simulator,  it  was  necessary  to  update  the  spreadsheet  with 
the  new  equipment  data.  Where  practicable,  equipment  was 
weighed.  If  not,  geometry,  density  and  material  were  used 
for  equipment  mass  property. 

2 .  Moments  of  Inertia  and  Principal  Axes 

The  principal  axes  coincide  with  the  body  axes  for 
purposes  of  my  simulations.  The  total  inertia  dyadic  of  the 
platform  is  the  sum  of  the  inertia  for  the  rigid  body 
platform  plus  the  parallel  axis  inertia  contribution  from 
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each  of  the  CMGs  since  the  moment  of  inertia  (MOI)  for  each 
CMG  is  not  constant  with  respect  to  time  in  the  body 
reference  frame.  This  inertia  dyadic  can  be  shown  by 
Equation  1 : 

j  =  1  V  ' 

Equation  1 .  Inertia  dyadic 

Where  [l]  is  a  3x3  identity  matrix,  \_rj"\  the  mass 

center  position  of  the  jth  CMG  and  rrij  is  the  mass  of  the 
individual  CMG. 

The  inertia  of  the  body  was  calculated  based  on 
scaling  the  original  MOI  from  GDC  for  the  mass  changes  made 
to  the  platform.  There  is  ongoing  effort  in  progress  to 
develop  an  accurate  MOI  for  the  platform  from  detailed  mass 
and  measurements  of  the  equipment  changes.  MOI  can  also  be 
compared  from  inertial  parameter  measurements  during 
operation  to  validate  the  spreadsheet  calculation  of  the 
platform  MOI . 

The  spreadsheet  as  updated  for  equipment  currently 
installed  shows  a  total  TASS2  mass  of  652.8  Kg.  This 
differs  from  the  weighed  (using  a  strain  meter)  mass  of  624 
Kg.  An  estimated  mass  can  be  calculated  once  fully 
operational  using  attitude  measurements. 

The  MOI  matrix  calculated  by  the  spreadsheet  shows  a 
MOI  of: 


I 


s 


262.1  -56.5 


M 


-56.5 


4.09 


373.7 

52.4 


4.09 

52.4 

270.3 


X  10"3 


Equation  2 .  TASS2  inertia  matrix 
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I xx  and  Izz  are  very  close  to  the  same  value  which  shows 
near  symmetry  about  both  the  X  and  Z  axes.  The  actual 
principal  axes  can  be  found  based  on  spreadsheet  values  or 
more  accurately  by  experimental  determination. 
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III.  SOFTWARE  DEVELOPMENT 


Software  development  was  carried  out  primarily  within 
Mathworks  Matlab  and  Simulink  programs.  Simulation  was 
performed  first  when  practicable  followed  by 
experimentation  to  validate  simulation  results. 

A.  REAL-TIME  WORKSHOP  AND  XPC  TARGET  INTEGRATION 

Real-Time  Workshop  and  xPc  Target  modules  in  Matlab 
and  Simulink  were  used  to  interface  the  simulink  control 
program  with  the  onboard  IEC.  Real-Time  Workshop  generates 
the  stand  alone  C  code  to  run  on  the  IEC.  XPc  Target  allows 
a  real-time  connection  to  the  IEC  for  control  and  provides 
IEC  specific  blocks  for  control  and  signal  processing. 

Development  was  done  primarily  in  Simulink  with  some 
Matlab  M  files  written  for  initialization  code.  Following 
modifications  to  the  Simulink  program,  the  program  was  then 
compiled  under  Real-Time  Workshop  and  uploaded  to  the  IEC. 
Once  uploaded  to  the  onboard  IEC,  the  program  was  executed. 
With  xPc  Target,  the  capability  exists  to  connect  to  the 
running  program  on  the  target  (IEC)  from  the  host  (desktop 
PC  where  development  is  done)  and  dynamically  update 
parameters,  observe  signals  and  interact  real-time  with  the 
executing  program . 


37 


THIS  PAGE  INTENTIONALLY  LEFT  BLANK 


38 


IV.  CMG  CONTROL  ANALYSIS 


A .  BACKGROUND 

CMGs  are  momentum  devices.  Angular  momentum  of  the  CMG 
is  aligned  with  the  spinning  rotor  axis.  Equation  3  defines 
angular  momentum  for  the  CMG. 


h 


CMG® r 


Equation  3 .  General  CMG  angular  momentum 


In  a  single  gimbal  configuration r  a  rate  of  change  in 
the  gimbal  angle,  S  produces  torque  according  to  the 
relationship  in  Equation  4  and  shown  graphically  in  Figure 
33. 


^  CMG  ^ CMG  ^  ^ 

Equation  4 .  CMG  torque 
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Figure  33 .  CMG  torque 
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The  above  equations  help  determine  the  sizing  of  the 
CMGs  as  well.  For  our  TASS,  we  used  the  max  rotor  speed  and 
thus  the  max  angular  momentum.  The  maximum  torque  is  then 
limited  by  the  maximum  gimbal  rate.  The  CMG  steering  law 
block  (written  by  MAJ  Timothy  Sands,  USAF)  has  a  saturation 
rad  a 

limit  of  n -  imposed  on  o  .  This  limits  the  maximum  torque 

s 

from  any  single  CMG  to: 

Tcmg  =  hCMG  x  8  =  24.4  Nms  ■  K  =  76.7  Nm 

s 

Equation  5 .  CMG  torque  output 

The  maximum  torque  of  the  three  CMG  arrangement  is 
therefore  3  x  76.7  Nm  —  230.1  Nm  . 

The  total  angular  momentum  of  the  TASS,  represented  by 
Hs  is  the  sum  of  the  angular  momentum  of  the  rigid  body  hB 
and  the  CMGs,  hCMG  => 


Hs  ^ CMG 


Equation  6 .  System  angular  momentum 


Since  hB  =  IB0)B 


HS  ^"b®B  ^ CMG 


Equation  7.  System  H,  function  of  I,  0 


The  rotational  equation  of  motion  (EOM)  is  given  by: 


Hs  +  (0BX  Hs  =  Text 


Equation  8 .  Rotational  EOM 
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Substituting, 


(A  +  Kmg)  +  X  (JB®B  +  ^CMG )  =  *EXT 

Equation  9 .  Expanded  rotational  EOM 


Similarly,  CMG  torque  can  be  defined  as: 


CMG  ^ CMG  ^ CMG 


Equation  10.  CMG  torque 

Since  TCMG  is  the  control  torque,  we  can  represent  it 
as  —  u  (I  use  negative  to  simplify  math  and  keep  the 
convention  used  in  Wie)  and  adding  it  to  both  sides  result 
in : 


IB(bB  +  X  IBC0B  =  TEXT  +  U 

and 


CMG  U  ®CMG 


X  h 


This  is  the  form  of  control  torque  used  as  the  input  to  the 
steering  logic  block  in  the  simulation. 


B.  CMG  STEERING  LAW 

The  CMGs  are  configured  in  a  modified  pyramid 
configuration.  The  traditional  pyramid  configuration  and 
would  be  Figure  34  including  the  null  fourth  CMG. 
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Figure  34.  Pyramid  CMG  configuration  [Ref.  5] 

The  exception  with  the  TASS  is  the  gimbal  axes  are  not 
perpendicular  to  the  pyramid  faces  as  in  Figure  34  but  lie 
parallel  an  in  the  face.  The  operation  is  similar  since  the 
gimbal  axis  g,  angular  momentum  axis  h  and  torque  axis  T 
are  orthogonal.  This  results  in  a  skew  angle,  (3,  of  -35.25°. 

Though  not  developed  by  the  author,  the  CMG  steering 
law  follows  the  relationship  where  the  CMG  angular 
momentum,  h  and  torque  X  vectors  lie  in  the  plane  of  their 
respective  CMG  rotor  and  perpendicular  to  the  side  of  the 
tetrahedron  they  occupy.  The  maximum  range  determined  by  a 
circle  based  on  the  maximum  angular  momentum  and  maximum 
torque  developed  by  each  CMG.  This  relationship  can  be  seen 
in  Figure  35  rotated  90°  to  coincide  with  our 
configuration.  Future  configurations  of  the  CMGs  might 
likely  be  a  box  configuration  (with  gimbal  axes  parallel  to 
the  lower  equipment  ring)  allowing  a  simple  setting  of  (3  =  - 
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90°  allowing  simpler  calculations ,  or  an  inverted  pyramid 
configuration  (top  of  pyramid  aligned  along  the  -Y  axis) 
and  a  (3  =  35.25°. 


h 
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s/  4 
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r 


VO 


Figure  35.  CMG  angular  momentum,  torque  plane  [Ref.  5] 

The  steering  law  follows  the  relationship  in  Bong  Wie 
[Ref.  7],  where  2iCmg  is  a  function  of  the  gimbal  angle 

=>  hCMG  =  h  (5)  .  To  find  gimbal  angle  trajectories  to  generate 

the  commanded  h  trajectory,  we  have  to  find  a  matrix  [ (*)i 
that  is  a  function  of  the  gimbal  angle,  <5,  such  that: 

Kmg  =  [A  (5)]  <5 

[a]  is  a  3x3  Jacobian  matrix  that  maps  the  gimbal 
rates  to  torque  such  that  hCMG  —  [a]  8 


[ 


<3l 


=  I  *A 


1  =  1 
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The  required  gimbal  rates  are  then  solved  for  by 


solving  hCMG  —  [a]  8  for  <5  : 

[>]+  Kmg  =  <5 

Equation  11.  Steering  law  gimbal  rates 

Since  [a]  is  singular,  a  direct  inverse  cannot  be 

taken.  We  use  Matlab's  Pinv()  command  to  take  the  Moore- 
Penrose  pseudo-inverse  in  the  steering  block. 

Bong  Wie  outlines  the  steering  logic  for  a  four  CMG 
pyramid  configuration  as  [Ref.  7] : 

hCMG  =  S  hi  (^i) 
i  =  1 

-c/3  sin  <5X  -  cos  d2  c/3  sin  d3  cos  <54 

=  cos  <5X  +  c/3  sin  S2  +  -  cos  83  +  c/3  sin  8 4 

s/3  sin  s/3  sin  82  s/3  sin  83  s[3  sin  84 

For  the  TASS  configuration,  there  is  no  CMG#4,  so  this 
term  is  left  off.  Add  to  that,  our 
/3  =  54.75°  —  90°  =  —35.25°,  then  the  TASS  equation  is: 

hCMG  =  S  hi  (5i) 
i  =  1 

—  .817  sin  82  -  cos  82  .817  sin  83 

-  cos  <5X  +  .817  sin  82  +  -  cos  83 

.  577  sin  .577  sin  82  .577  sin  83 

Equation  12 .  Individual  CMG  angular  momentum 
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817  sin  S1  -  cos  S2  .  817  sin  S3 

[a]  =  cos  d2  +  .817  sin  d2  +  -  cos  83 

.577  sin  d2  .577  sin  52  .577  sin  83 

Equation  13.  [A]  matrix 

Where  <5  represents  the  gimbal  angle  rate  and  CT  (ccr) 

the  pseudo-inverse  of  C.  Thus  Equation  11  can  be  reduced  to 
Equation  14  where  k  represents  an  arbitrary  vector  of  n 
elements . 

-.817  sin  S1  -  cos  S2  .817  sin  S3 
S  =  cos  .817  sin  S2  -  cos  S3  hCMG 

.577  sin  S1  .577  sin  d2  .577  sin  S3 

Equation  14.  TASS2  CMG  steering  law 

The  pseudo-inverse  is  commonly  represented  by  the 

notation  [a]  =  [a]  |[a]  [a]  j  [Ref.  7]  .  The  CMG  steering  law 

implemented  in  Simulink  can  be  seen  in  Figure  59. 

C .  CMG  CONTROLLER 

The  CMG  controller  was  simulated  using  two  control 
methods.  First  a  PID  controller  was  implemented  based  on 
Euler  angle  errors.  Difficulty  was  encountered  in  getting 
the  simulation  stable  and  adjusting  the  gains  so  a 
different  feedback  method  was  attempted.  The  second  method 
was  based  on  quaternion  error  feedback  control.  There  were 
a  few  advantages  to  pursuing  this  method. 

TASS1,  a  reaction  wheel  (RW)  based  simulator  was 
controlling  using  quaternion  error  feedback,  Dr.  Kim 
(thesis  co-advisor/second  reader)  had  already  developed  a 
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controller  and  the  Extended  Kalman  Filter  (EKF)  for  TASS1 
and  quaternion  feedback  was  free  of  singularities.  Not  that 
our  testbed  would  pass  through  any  region  of  singularity, 
but  quaternion  feedback  allowed  us  the  freedom  to  ignore 
singularities . 

The  quaternion  controller  can  be  seen  in  Figure  65. 
Since  quaternion  attitude  control  was  already  being 
performed,  it  was  a  trivial  task  to  extract  the  current 
attitude  quaternion  qa  and  calculate  the  target  or  desired 
quaternion  qrt.  Unlike  error  determination  in  a  typical 
controller,  subtraction  of  the  actual  attitude  from  the 
desired  attitude  can  not  be  done  with  quaternions. 
Quaternion  error  is  calculated  by  multiplication,  such  that 
the  quaternion  error  is  calculated  by  [Ref.  7,11]  : 

<?e  =  <3Ta  *  <?t 

Equation  15.  Quaternion  error 

The  output  of  the  quaternion  feedback  controller  was 
commanded  torque.  This  was  sent  to  the  CMG  steering  block 
for  CMG  gimbal  angle  commands. 

D.  SINGULARITY  AVOIDANCE 

In  any  CMG  steering  law,  singularities  can  be 
expected.  Each  CMG  geometrical  configuration  has  its 
advantages,  but  inevitably  must  plan  to  avoid  singular 
regions.  Singularity  avoidance  schemes  were  not  implemented 
in  this  thesis. 

E.  CMG  SIMULATION  ANALYSIS 

The  controller  was  implemented  in  Simulink  with  some 
initialization  done  in  Matlab  'M'  files.  The  block  diagrams 
can  be  seen  in  Appendix  B.  For  simplification  in  running 
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multiple  simulations  and  varying  parameters,  a  graphical 
interface  was  created  as  shown  in  Figure  36. 


Figure  36.  Simulation  graphical  interface 

From  this  interface  it  was  possible  to  specify 
parameters  such  as  CG  offset,  CMG  controller  gains,  TASS 
and  balancer  masses,  commanded  position  for  slew  maneuvers 
and  mode  of  operation:  stability  or  position  command.  Check 
boxes  were  also  available  for  selecting  noise,  delay, 
disturbance,  gravity  torque  or  whether  to  compensate  with 
the  mass  balancers. 

The  noise  parameter  was  based  on  observed  noise  from 
the  sensors  and  added  to  simulated  sensor  outputs  for  CMG 
gimbal  position  and  measured  TASS  angular  velocity.  The 
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noise  was  a  Gaussian  distribution  with  a  variance  of 


2  X  10  4  rad  (.01°)  and  frequency  of  100  hz  as  shown  in 
Figure  37 . 


Figure  37 .  Gaussian  noise 

Delays  used  were  varied  depending  on  the  signal  line 
being  delayed.  Any  delay  used  was  an  integer  multiple  of 
the  sample  time.  The  largest  delay  used  anywhere  in  the 
simulation  was  four  times  the  sample  time.  Though  no  actual 
times  were  measured  from  the  TASS,  due  to  the  wireless 
connection,  delays  can  be  higher  than  a  direct  connected 
control  system.  Sample  time  was  set  at  .025  to  correspond 
to  a  worst  case  hardware  sample  frequency  of  40  Hz. 

The  first  simulation  is  an  ideal  run  for  comparisons. 
No  noise,  delays,  disturbances  or  gravity  torque  were 
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introduced.  The  first  was  a  commanded  position  slew  +5° 
about  the  X  axis  as  seen  in  Figure  38. 


Figure  38.  Euler  angles,  5  degree  slew  about  +X,  ideal 

Critically  damped,  rise  time  (Tr)  can  be  seen  to  be 
5.25  sec,  settling  time  Ts  =  10  sec. 


Figure  39.  CMG  torque,  5°  slew  in  +X,  ideal 
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Figure  40.  CMG  gimbal  angles,  5°  slew  in  +X,  ideal 


Figure  41.  CMG  gimbal  rates,  5°  slew  in  +X,  ideal 


Gimbal  angles,  rates  and  torque  can  all  be  seen  to 
settle  by  about  14  seconds.  To  be  noted  is  the  fact  they  do 
settle  to  zero.  Under  ideal  conditions  with  no  CG  offset, 
the  simulator  remains  balanced  throughout  the  maneuver 
eliminating  the  necessity  for  the  CMGs  to  produce  torque. 
In  an  unbalanced  condition,  not  corrected  for,  the  CMGs 
would  have  a  positive  S  as  long  as  the  unbalanced  situation 
remained.  Eventually,  the  CMGs  would  saturate  and  the 
simulator  would  no  longer  be  controllable.  Saturation 
results  can  be  seen  in  Figure  42,  Figure  43,  Figure  44  and 
Figure  45.  The  180°/sec  limit  imposed  on  gimbal  rates  can 
be  clearly  seen  at  saturation  in  Figure  45. 


Figure  42.  Euler  angles,  5°  slew,  saturated 
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Figure  43.  CMG  torque,  5°  slew,  saturated 


Figure  44.  CMG  gimbal  angle,  5°  slew,  saturated 
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Figure  45.  CMG  gimbal  rates,  5°  slew,  saturated 
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V. 


MASS  BALANCING  AND  ANALYSIS 


A .  BACKGROUND 

The  TASS  is  required  to  support  the  BFRM  in  such  a  way 
as  to  allow  milliradian  pointing  accuracy.  In  order  to 
accomplish  this,  eliminating  not  only  disturbances  in  the 
laser  beam,  but  disturbances  in  the  bus.  One  of  the  major 
external  disturbances  affecting  the  platform  is  due  to  the 
gravity  torque  (T  )  present  with  any  offset  in  the  CG 
perpendicular  to  gravity. 

With  an  offset  in  the  CG,  the  CMGs  will  be  commanded 

in  such  a  way  as  to  counter  this  T  and  maintain  the 
2  g 

commanded  attitude.  CMG  gimbal  position  will  be  commanded 
to  produce  the  required  torque.  Any  motion  of  the  CMGs  will 
introduce  vibration  and  unwanted  disturbances  into  the  bus 
that  would  need  to  be  eliminated  at  some  point  in  the 
optical  path. 

By  actuating  the  three  masses  on  the  platform  in  such 
a  way  so  as  to  return  the  CG  back  to  the  CR  (or  a  vertical 
line  passing  through  this  point)  would  eliminate  any  torque 
requirement  from  the  CMGs  to  maintain  a  desired  attitude.  A 
reduction  in  torque  output  would  have  a  corresponding 
reduction  in  disturbances  and  an  increase  in  pointing 
accuracy . 

B.  DERIVATION  OF  EQUATIONS 

For  reference  during  derivation.  Figure  46  shows 
graphically  the  entities  involved  and  their  relative 
positions . 
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Figure  46.  Mass  Coordinate  System 


r,  represents  the  position  of  any  of  the  balance  masses  mi  . 
riQ  is  the  starting  position  of  mass  mi  .  rCG  is  the  position 

vector  for  the  center  of  gravity  offset.  si  is  a 
representative  unit  vector  along  the  path  of  the  balance 
mass.  di  is  the  distance  traveled  for  any  mass  mi  . 

The  torque,  T  ,  on  the  center  of  gravity,  due  to 
gravity  is  designated  by  Tcg  .  Tcg  follows  the  relationship 

shown  in  Equation  16,  where  F  =  Mg  and  M  is  the  mass  of  the 
platform  minus  the  balance  masses  [Ref.  1,2] . 

f  =  rrr  X  F 

eg  CG 

Equation  16.  General  torque 

f  =  rrr  x  Mg 

Equation  17.  Torque  as  a  function  of  gravity 
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Accounting  for  the  gravity  torque  contribution  due  to 
the  balance  masses  is  done  in  the  same  manner  with  each  of 
the  masses  and  its  associated  position  vector  shown  in 
Equation  18. 


T,  =  r.  X  m.q 

b  1 

Equation  18.  Single  balance  mass  torque 

Equation  18  represents  the  contribution  on  one  balance 
mass.  The  contribution  of  all  three  balance  masses  is 
simply  the  summation  of  the  three  individual  mass 

components  as  in 

3 

t  =  X  fi x 

i  =  1 

Equation  19.  Total  balance  mass  torque 

The  total  gravity  torque,  T  f  is  the  sum  of  the  two 
torques : 

3 

f  =  f  +  f.  =^>  f  =  rh  X  Mg  +  Y  r.  X  m.g 

g  eg  b  gg  CG  J  1  jV 

i  =  l 

Equation  20.  Gravity  torque 


As  can  be  seen  in  Figure  46A  r,  is  the  sum  of  the 
components  r.  0  and  cf  : 


r.  =  r. 


+  d. 


Equation  21.  Mass  position  vector 


Since  position  commands  for  the  balance  mass 
controllers  will  be  issued  in  terms  of  body  coordinates,  it 
will  be  advantageous  to  represent  the  above  equations  in 
terms  of  the  body  reference  frame.  All  terms  in  the  above 
equations  are  already  specified  in  terms  of  the  body 
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reference  frame  with  the  exception  of  gravity  g  which  is 
expressed  in  the  inertial  reference  frame  as  Ng  .  To  convert 
Ng  to  the  body  reference  frame,  a  coordinate  transformation 
with  an  appropriate  rotation  matrix  BRN  : 

Bg  =  BRNNg 

Equation  22 .  Gravity  transformation 

=>  Tg  =  rCG  X  MBRNNg  +  ^r.  X  miBRNNg 

1=1 

In  a  balanced  condition,  f  =  0  =  f  +  f,  and 

'  g  eg  b 

0  =  rCG  X  MBRNNg  +  ^r.  X  miBRNNg  =^> 

i  =  1 

3 

0  =  rCG  X  +  Ir.  X  mBg 

i=i 

Equation  23.  Balanced  torque  condition 

If  there  is  not  an  unbalanced  situation,  there  is  no 
CG  offset  and  by  definition,  the  balance  masses  must  be  in 
their  home,  balanced  position. 

If  the  TASS  CG  deviates  from  its  position  while  in  a 
balanced  condition,  it  is  necessary  for  the  balance  masses 
to  move  in  such  a  manner  so  as  to  return  the  TASS  CG  to  a 
position  along  the  vertical  axis  passing  through  the  CR.  To 
find  the  required  balance  mass  positions  to  return  to  a 
balanced  condition,  one  need  only  solve  Equation  23  for 

each  of  the  three  d.  vectors.  It  is  instructive  to  note  each 

i 

balance  mass  is  constrained  to  move  along  one  primary  axis 
and  thus  d±  is  measured  along  one  unit  vector  for  its 
respective  axis: 
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10  0 
dx  =  d1  0  ,  d2  -  d2  1  ,  d3  -  d3  0 

°J  [oj  [l 

"dj  To]  To]  [  d2~ 

=>  dx  -  0  ,  d2  -  d2  ,  d3  -  0  and  d  -  d2 

0  0  d3  d3 

Converting  to  matrix  notation  allows  easier 
manipulation  of  the  equations.  The  skew  symmetric  notation 

to  convert  Bg  to  a  3x3  matrix  where: 

0  -g3  g2 

Bgx  =  g3  0  -g2 

-g1  g1  o 

Equation  24.  Skew  symmetric  notation  of  gravity 

Reversing  the  cross  product  operations  gives: 

3 

0  =  -MBg  X  rCG  +  —mBg  X  f. 


3 


0  = 

-M[Bgx][rCG]  -  [ 

i  =  l 

v]H 

since  m.  and 

l 

[Bgx]  are 

constant 

and  identical 

for  all 

three  masses  and 

position 

vectors , 

they  can  be 

brought 

outside  the  summation: 

0  =  -M  [  V]  [rCG]  -  m.  [  V]  X  [ri] 

i  =  1 


From  Equation  21: 
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0  =  ~M  [  v]  [rCG]  -  rn.  [  V]  X  [ri,o]  +  [di] 

2  =  1 


Since  [r.]  =  [rj  +  [d.]  : 
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Continuing  to  solve  and  eliminating  the  summation  we 

have : 

0  =  ~M  [  V]  [rCG]  ~  m.  [ Bgx]  ([r0]  +  [<*]) 

M  [  V]  [rcc]  =  ~mi  [  V]  ([>0]  +  [d]) 

vM[V]+[rcs]-[r0]  =  [d] 

Equation  25.  Balance  mass  positions 

where  [  ]  represents  the  pseudoinverse  . 

C.  DETERMINATION  OF  CG  OFFSET 

The  controller  developed  for  mass  balancing  assumes 
the  CG  offset  is  known.  This  was  done  in  order  to  simulate 
and  collect  data  while  developing  an  initial  software 
control  program.  This  will  often  not  be  the  case  in  actual 
TASS  operation. 

The  CG  vector  rCG  has  components  both  perpendicular  to 
gravity  and  parallel  and  only  the  perpendicular  component 
can  be  measured  directly  [Ref.  1,2,8]. 

T  —  T  T 

-‘-CG  ^ CGI.  1  J~CG\  | 

Equation  26.  CG  components 

The  perpendicular  component  can  be  measured  by 
measuring  the  individual  d±  positions  when  a  balanced 
condition  is  achieved  and  solving  Equation  25  for  rCG .  This 
also  assumes  g  is  known  in  testbed  coordinates. 

The  TASS  is  then  maneuvered  to  a  new  attitude  and  a 
new  set  of  measurements  are  taken.  Since  the  change  in 
attitude  should  be  readily  measured  from  onboard  sensors,  a 
rotation  matrix  from  attitude  a  to  attitude  b  can  be 
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determined :  W-  »  from  measurement  a  can  be  transformed 

to  measurement  b  by:  bg  —  [j?  T '  M  ■  Since  rCG  =  rCG±  +  rCG|  , 

[rcG]  =  a[ral]+  a[rall]aM 

and 

Setting  the  two  measurements  equal: 

Solving  for  rCG|  ^  : 

'kx]-‘hx]=  “hJ'W'H-'hJ'H 

[*W  >]"[>] 

lrb\  iJJ 

*kx]-'[rx][*[d  ‘[«T'Wj=  H 

L  LmJ 

Equation  27.  Parallel  components  of  CG 

D.  MASS  BALANCE  SIMULATION 

The  next  phase  of  the  development  modified  the  CMG 
quaternion  controller  with  a  mass  balance  controller.  All 
files  and  models  can  be  found  in  Appendix  B.  Once  the 
balance  mass  positions  were  solved  for  in  Equation  25,  a 
controller  and  steering  logic  were  designed. 

Essentially,  the  objective  was  to  eliminate  the  effect 
of  Tg .  A  PD  controller  was  initially  designed  for  simplicity 


r  n 

b  r  i 

1 

i- 

-  Lrb±] 
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and  evaluation  of  the  control  algorithm.  Some  unwanted 
effects  such  as  the  desired  error  not  reaching  zero 
completely  (a  characteristic  of  PD  control) ,  unwanted 
perturbations  and  difficulty  in  selecting  gains  were 
observed  with  this  method.  An  integral  gain  was  added  to 
complete  a  PID  controller  which  removed  unwanted  behavior 
and  was  more  stable. 

Choosing  Tg  as  our  error  to  minimize  allowed  a  compact 
calculation  for  [d]  .  E  quation  20  showed  that 

3 

i  =  C  +  t  =>  *gg  =  rca  X  Mg  +  ^  r.  X  m.g  .  Solving  for  [d]  can 

i  =  l 

be  implemented  as  [Ref.  1,2] : 

3 

f  -  f  =  f.  =  T  r.  X  m.g 

g  eg  b  i  i-' 

1=1 

=  ~mi  [v]Xk] 

i=i 

Based  on  the  relationship  for  r.  in  Equation  21, 

k]  =  [no]  +  M 

and 


w-w  =  -"iv]ik] 

i  =  1 


^  h]  -  RcJ  =  ~mi  [V]X([r1;0]  +  [dj) 

i  =  l 
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and  solving  for  [d]  in  similar  fashion  as  in  Equation 

25: 

[r»]  “  [r«]  =  ~m,  [V]([r,]  +  [d]) 

-  W][vJ  -  [ro]  -  [d] 

i 

Equation  28.  Calculation  of  [d]  in  terms  of  torque. 

E.  MASS  BALANCE  ANALYSIS 

The  next  simulations  introduced  noise,  sinusoidal 
disturbance,  delays  and  gravity  torque  one  at  a  time  noting 
the  results  at  each  point.  Only  the  ideal  case  presented 
earlier  and  the  case  with  all  anomalies  will  be  shown  for 
brevity.  If  the  simulation  works  with  worst  case  anomalies, 
it  should  work  for  those  cases  in  between  worst  case  and 
ideal . 

Conditions  for  the  following  results  are  shown  in 
Figure  47 . 
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Figure  47.  Simulation  parameters,  2mm  CG,  worst  case 


Figure  48.  Euler  angles,  2mm  CG  offset,  worst  case 
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The  X  axis,  shown  in  yellow,  took  about  the  same  time 
to  settle  to  the  commanded  5°  position  and  only  slightly 
greater  rise  time  (by  .25  seconds)  .  The  more  notable 
difference  occurred  on  the  Y  and  Z  axes.  Where  the  ideal 
situation  had  disturbances  in  these  axes  settled,  in  about 
16  seconds,  here  it  took  almost  twice  as  long  to  fully 
settle  to  the  commanded  position. 


Figure  49.  Euler  X  axis,  2mm  CG  offset,  zoomed 

Upon  closer  inspection  of  the  commanded  angle  of  5°,  a 
fluctuation  (due  to  the  inserted  sensor  noise  shown  in 
Figure  37)  of  ±0.02°  can  be  observed. 
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Figure  50.  Euler  Y,  Z  axes,  2mm  CG  offset,  zoomed 

Figure  50  shows  a  fluctuation  (due  to  the  inserted 
sensor  noise)  of  ±0.02°  can  be  observed  in  the  Y  and  Z  axes 
as  well. 


67 


Figure  51.  Gravity  torque,  2mm  CG  offset,  worst  case 

Figure  51  shows  the  gravity  torque  response  for  the 
2mm  CG  offset  during  a  commanded  5°  slew.  Without  balance 
mass  movement,  this  would  be  constant  throughout  the 
maneuver.  Coupling  in  the  axes  can  be  seen  by  the  slight 
perturbation  in  gravity  torque  for  one  of  the  other  axes. 
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Figure  52.  CMG  torque,  2mm  CG  offset,  worst  case 

The  CMG  torque  in  Figure  52  takes  slightly  longer  to 
settle  out  than  the  ideal  case  in  Figure  39.  Noisy 
variations  in  torque  can  be  observed  as  well. 
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Figure  53.  CMG  gimbal  angles,  2mm  CG  offset,  worst 


Figure  53  shows  a  much  different  CMG  gimbal  angle 
profile  than  the  ideal  condition.  The  gimbal  angles  in  the 
worst  case  moved  more  than  three  times  the  magnitude  of  the 
ideal  case.  The  peaks  also  took  longer  to  occur. 

The  gimbal  angles  do  not  return  to  zero  since  there  is 
a  CG  offset  to  counter.  At  the  time  the  mass  balancers 
compensate  for  the  CG  offset,  the  zero  torque  position  for 
the  gimbal  angles  has  changed.  Under  the  ideal  case,  the 
TASS  was  perfectly  balanced  and  the  change  imparted  to  the 
gimbals  was  taken  out  to  stop  the  TASS  at  the  commanded 
attitude . 
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Figure  54.  CMG  gimbal  angles,  2mm  CG  offset,  zoomed 


Figure  54  shows  a  zoomed  in  portion  of  Figure  53. 
Though  noise  in  the  system  is  causing  the  gimbal  angle 
variation,  this  does  not  take  into  account  friction. 
Friction  was  not  modeled  in  the  gimbal  gearing  or  the 
bearings.  Friction  would  likely  reduce  the  gimbal  angle 
variation . 


Figure  55.  CMG  gimbal  rates,  2mm  CG  offset 


Figure  56.  dx  balance  mass,  2mm  CG  offset,  5°  +X 
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Figure  56  shows  the  mass  balancer  position  change 
during  the  commanded  maneuver.  Since  the  CG  offset  was  +  2mm 
along  the  X  axis,  we  expect  to  see  the  change  in  the  X  axis 
mass  balancer  to  a  more  negative  position.  Here  the  move  is 
about  34mm  in  the  -X  direction.  This  is  well  within  the 
±75mm  travel  limitation  of  the  balancers. 


Figure  57.  dy,  dz  balance  masses,  2mm  CG  offset,  5°  +X 


Figure  57  shows  a  shift  in  the  Y  balance  mass  in  the 
-Y  direction  by  9mm.  This  is  also  expected  as  the  attitude 
increases  in  the  +X  direction.  As  the  angle  between  the 
inertial  horizontal  and  the  +X  axis  increases,  the  Y 
balance  mass  is  tilted  back  slightly  and  influences  the 
overall  CG  correction.  To  aid  in  the  correction,  the  Y 
balance  mass  moves  downward  slightly. 
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VI.  FUTURE  WORK 


A.  EXPERIMENTATION  AND  SOFTWARE 

Towards  the  end  of  research,  one  of  the  CMGs  was 
returned  to  the  manufacturer  to  upgrade  the  controller 
electronics  and  repair  some  sources  of  noise  noted  in 
II. C. 2  and  shown  in  Figure  12.  Very  little  experimentation 
with  the  CMG  Quaternion  Controller,  that  was  developed,  was 
possible.  Early  in  the  development  the  CMGs  were  run  and 
the  controller  seemed  to  perform  in  a  stabilizing  mode  for 
a  short  period  of  time.  Difficulty  in  determining  adequate 
controller  gains,  problems  with  the  CMG  gearing  set  screws 
and  a  small  field  of  view  of  the  IR  sensor  (±10°)  all 
combined  to  produce  and  unstable  and  divergent  behavior 
with  simulations  greater  than  about  20  seconds  or  so.  No 
data  was  gathered  during  this  early  development  period. 

System  identification.  Mass  properties  including 
moments  of  inertia  were  developed  from  the  original 
spreadsheet  by  scaling  for  the  change  in  mass  from  the 
delivered  configuration  to  the  configuration  with  the 
optical  payload  installed.  Accurate  determination  of  the 
mass  properties  will  be  needed.  Friction  modeling  for  CMG 
gimbal  axes  and  bearings. 

Sensor  output  filtering.  Current  sensor  outputs  are 
noisy  even  with  the  Extended  Kalman  Filter  (EKF) .  Spikes  of 
up  to  1.5°  were  seen  on  some  attitude  sensors.  This  will 
not  be  acceptable  for  fine  pointing  modes  of  the  simulator. 

B.  HARDWARE 

1 .  Star  Sensor 

Incorporating  the  Star  Sensor  as  researched  by  LT 
Connolly  is  also  needed.  The  precision  this  sensor  is 
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capable  of  will  be  required  for  fine  pointing  of  the 
simulator . 

2 .  Magnetometer 

Integration  of  the  three-axis  magnetometer.  Though 
difficult  to  calibrate  in  the  presence  of  interference  from 
environmental  ferrous  material,  the  Billingsley  Magnetics 
TF100M-G2  could  be  accurate  enough  for  determination  of  an 
inertial  "North" .  Used  differentially  with  a  second 
magnetometer,  it  has  a  potential  for  high  accuracy  for 
position  determination  about  the  AY'  axis  or  "pitch". 

3 .  Optical  Payload 

The  BFRM  payload  has  a  great  deal  of  integration  left. 
Jitter  control,  expanded  field  of  view,  beam  front 
disturbance  rejection,  wireless  connectivity  and 
integration  with  the  flight  control  unit  are  just  a  few 
areas . 

4 .  Physical  limits 

To  protect  the  simulator  in  the  event  of  uncommanded 
torque  inputs  or  flight  software  errors,  a  physical  system 
around  the  base  of  the  simulator  is  needed.  This  hardware 
will  prevent  the  simulator  lower  deck  from  contacting  the 
air  bearing  pedestal.  A  software  implementation  of  possibly 
an  auto-stabilizing  LQR  controller  can  be  added  as  well. 

5 .  CMGs 

Singularity  avoidance  schemes  will  need  to  be  pursued 
for  full  implementation  of  the  CMGs.  Position  feedback 
filtering  and  optimization  of  the  sampling  bandwidth  will 
need  to  be  incorporated  in  the  future . 
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VII.  SUMMARY  AND  CONCLUSIONS 


Much  work  has  gone  into  the  initial  stages  of 
developing  the  hardware,  the  software  and  dealing  with  each 
new  anomaly  that  arose  during  testing.  Quite  a  bit  more 
work  remains  to  be  done. 

Mass  balancing  was  done  with  a  KNOWN  Cg  offset.  This 
was  strictly  to  develop  a  working  controller  and 
simulation.  Under  real  conditions  the  CG  offset  will  not  be 
known  and  would  have  to  be  determined  from  system 
parameters  and  repeated  measurements  in  different 
attitudes.  Some  issues  that  present  themselves  for  future 
work  are  finite  positioning  of  the  balance  masses.  Best 
stated  accuracy  for  the  installed  balancers  is  18  |LLm  . 
Encoder  scale  factor  is  191.63  counts  per  mm  [Ref.  10]  . 
This  results  in  1  count  moving  the  mass  ±5.2  |Um  along  its 
respective  axis.  Working  Equation  25  in  reverse  and  solving 
for  CG  offset  given  a  mass  displacement  r  it  is  found  a 
single  mass  can  influence  the  CG  by  no  more  than  .0955  |Hm. 
Being  able  to  position  the  CG  towards  the  CR  within  .0955  |Hm 
would  result  in  a  natural  frequency  of: 


(0  = 


m  -  gr  - 


I 


624 Kg  •  9.81  m  •  9.55  x  10_8m 
y  162.6 Kg  ■  m2  •  sec2 

=  1.896  x  10"3  rad/  =  3313.1  sec/ 
/sec  /2; 


2k 


If  a  specific  COn  is  required  to  prevent  the  CMGs  from 
saturating  for  some  uninterrupted  period,  the  above 
calculation  can  be  reversed  to  calculate  what  CG  offset  is 
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required  to  produce  that  period.  Once  the  period  was 
obtained,  the  CG  would  be  known  within  given  bounds  based 
on  the  stated  period. 

This  thesis  accomplished  the  objectives  set  at  the 
beginning  of  development:  to  develop  an  initial  CMG  control 
program,  develop  and  integrate  the  mass  balancers  with  the 
TASS  and  flush  out  the  initial  anomalies  associated  with 
the  development  of  a  complicated  mechanism  such  as  the 
TASS. 
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APPENDIX  A: 


MASS  PROPERTIES  SPREADSHEET 


Weight  ea 

(kg) 

15.876  II 

1 £ST6 

2.200  II 

1.632  1 

1.087  I 

0.567  | 
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0.331  1 
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0.392  1 
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o 

o 

00 

o 

o 

00 

''fr 
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0.953  1 
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0.227  1 

0.221  1 

o 

o 

d 
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o 

o 

o 

■'t 

o 

o 

o 

d 
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o 

+ 

LU 
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O 

q 
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q 

d 

ro 
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+ 
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o 

rv 

fN 

CO 

o 

+ 

LU 
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r\i 
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LU 

LO 
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(w) 
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o 
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o 

0.0254 
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0.0127 
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o 
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o 
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0.2032  1 

0.1524  | 
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o 

|  9609‘0 
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CO 
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APPENDIX  B:  MATLAB/SIMULINK  FILES 


Figure  58 .  Simulation  program 


Figure  59.  CMG  steering 
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Figure  60 .  Body  dynamics 
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Figure  61 .  Balance  torque  calculation 
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Figure  62 .  Balance  PID  controller 
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Figure  63 .  Balance  steering 
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Figure  66. 


Matlab  'M'  file  for  CMG  parameters 


96 


APPENDIX  C:  EQUIPMENT  SPECIFICATION  SHEETS 
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B .  MASS  BALANCER 
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